import numpy as np

HOME_JOINT   = [36,-41,  -79,   57   ]
HOME_JOINT_7 = [36,-41,0,-79,-1,57,59]

MTX = np.array([[939.659585 ,0.000000 ,630.824854],
                    [0.000000 ,936.384354 ,371.477445],
                    [0.000000 ,0.000000 ,1.000000]])

DIST = np.array([0.132448,-0.317935,0.001020,-0.001714,0.000000])


# if __name__ == "__main__":
    # from PointTF import  PointCalculation
    # import rospy
    # rospy.init_node('move_group_python_interface_tutorial', anonymous=True)
    # distance = 690
    # tf = PointCalculation()
    # point = [468.75, 344.0]
    
    # PointCam2 = Cal(point,distance,MTX_NEW)

    # pointpanda2  = np.array(tf.pointcal(PointCam2/1000))

    # print(PointCam2)
    # print(pointpanda2)